home *** CD-ROM | disk | FTP | other *** search
/ Amiga Format CD 46 / Amiga Format CD46 (1999-10-20)(Future Publishing)(GB)[!][issue 1999-12].iso / -in_the_mag- / reader_requests / scilab / demos / velpic / testpt.f < prev    next >
Text File  |  1999-09-16  |  3KB  |  81 lines
  1.       subroutine testpt(p1,p2,nc,xyline,flag,count,bav)
  2. c <flag,bav>=testpoint(p1,p2,line)
  3. c <flag,bav>=testpoint(p1,p2,line)
  4. c macro which tests whether the line segment defined by the
  5. c two points p1 and p2 intersects any of the line segments
  6. c in line.
  7. c  p1   :2x1 matrix giving the indices of point number one
  8. c  p2   :2x1 matrix giving the indices of point number two
  9. c  line :2xN matrix giving the indices of a line
  10. c  flag :flag='on' indicates an intersection, flag='off' 
  11. c       :indicates no intersection
  12. c  bav  :3xM matrix giving all the intersections found (if any)
  13. c       :and the position in the line of the intersection
  14. c 
  15. c!
  16. c author: C. Bunks     date: 12-NOV-90
  17. c /two line segments defined by (p1,p2) and (q1,q2)
  18. c have a point in common if there exists two constants
  19. c a and b such that 0<=a<=1 and 0<=b<=1 
  20. c and 
  21. c                (1-a)*p1+a*p2=(1-b)*q1-b*q2
  22. c or 
  23. c                                 [b]              
  24. c                [(q2-q1) (p1-p2)][ ] = (p1-q1)
  25. c                                 [a]              
  26. c 
  27. c NOTE: Could return the wrong value when the line segment
  28. c passes through an end point of the line sequence. Thus
  29. c all line segments on a grid point must be perturbed.
  30.  
  31.       integer      nc,flag,count
  32.       real         bav(3,nc),xyline(2,nc)
  33.       real         p1,p2,pd,q1
  34.       real         q2,qd,vec,ba,detm
  35.       dimension    p1(1,2),p2(1,2),pd(1,2),q1(1,2)
  36.       dimension    q2(1,2),qd(1,2),vec(1,2),ba(1,2)
  37.  
  38.       count=0
  39.       do 10 k=1,nc-1
  40.          q1(1,1)=xyline(1,k)
  41.          q1(1,2)=xyline(2,k)
  42.          q2(1,1)=xyline(1,k+1)
  43.          q2(1,2)=xyline(2,k+1)
  44.          if(int(q1(1,1)).eq.q1(1,1).and.int(q1(1,2)).eq.q1(1,2))then
  45.             q1(1,1)=q1(1,1)+.001
  46.             q1(1,2)=q1(1,2)+.001
  47.          endif
  48.          if(int(q2(1,1)).eq.q2(1,1).and.int(q2(1,2)).eq.q2(1,2))then
  49.             q2(1,1)=q2(1,1)+.001
  50.             q2(1,2)=q2(1,2)+.001
  51.          endif             
  52.          qd(1,1)=q1(1,1)-q2(1,1)
  53.          qd(1,2)=q1(1,2)-q2(1,2)
  54.          pd(1,1)=p1(1,1)-p2(1,1)
  55.          pd(1,2)=p1(1,2)-p2(1,2)
  56.  
  57.          detm=-qd(1,1)*pd(1,2)+qd(1,2)*pd(1,1)
  58.          if(detm.ne.0)then
  59.             vec(1,1)=p1(1,1)-q1(1,1)
  60.             vec(1,2)=p1(1,2)-q1(1,2)
  61.             ba(1,1)=(pd(1,2)*vec(1,1)-pd(1,1)*vec(1,2))/detm
  62.             ba(1,2)=(qd(1,2)*vec(1,1)-qd(1,1)*vec(1,2))/detm
  63.  
  64.             if(0.le.ba(1,1).and.ba(1,1).le.1.and.
  65.      +         0.le.ba(1,2).and.ba(1,2).le.1)then
  66.                count=count+1
  67.                bav(1,count)=(1-ba(1,2))*p1(1,1)+ba(1,2)*p2(1,1)
  68.                bav(2,count)=(1-ba(1,2))*p1(1,2)+ba(1,2)*p2(1,2)
  69.                bav(3,count)=k
  70.             endif
  71.          endif
  72.  10   continue
  73.  
  74. c if the number of intersections is odd then an intersection
  75. c occured
  76.  
  77.       if(int(count/2).ne.float(count)/2.) flag=1
  78.  
  79.       return
  80.       end
  81.